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INITIALIZE KALMAN FILTER WITH STORED 
INITIAL VALUES FOR THE ESTIMATED TAPE 
PACK RADIUS r - AND THE ESTIMATED 
ESTIMATION ERROR VARIANCE V - AND 
TAKE INITIAL POSITION MEASUREMENTS 



FROM 
322 
(FIG. 2B) 



FROM ■ 

400 
(FIG. 3) 



TAKE A NEXT SET OF POSITION 
MEASUREMENTS AND CALCULATE 
Aec, Aga AND Agr 



302 



calculate a radius measurement _y 
rm = Rc aqc-a^aaqa 

Agr 



304 




CALCULATE THE MEASUREMENT ERROR 
VARIANCE 

o-Ti^ = [Rc2o-c2 + Uf^(T[^ + Rm2o-r2] 



FIG. 2A 



TO 312 
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313 



IF 0-2 < 0-2 
M MIN 



SET a-2 
M 



= 0-2 



MIN 



NO 



FROM 310 



IS 

0-2 
MIN 

M MAX, 
9 



312 



YES 




316 



IS 



NO 



315 



1 



YES 



THE3or INTERVAL 
AROUND Rm WITHIN THE 
RANGE rMIN to rM> 
? 

NO 



YES 



SET r + = r - 
AND V + = V - 
AND GO TO 
STEP 322 



318 



CALCULATE THE KALMAN 

FILTER GAIN 

V - 
K= 



320 



UPDATE ESTIMATES OF THE TAPE 
PACK RADIUS AND THE ESTIMATION 
ERR9R VARIANCE . 
r + = f - + K(Rm - r -) 
V + = (1-K) V- 




TO 302 



FIG. 2B 



PREDICT NEW ESTIMATES 
FOR NEXT SAMPLE TIME 

6 



r - = r + 



2tt " 
AND 



V - = V + 



+ (72 

V 



4/4 



TO 302 
(FIG. 2 A) 




SET r + = r - 
V + = V - 

AND CALCULATE ESTIMATES 



A A ^ 

r - = r + +- — Ae □ 
2tt " 

AND 

V - = V + + cr2 



y 404 

USE THE POSITION 
MEASUREMENTS AS 
©C-. ©A-AND GR. 



FIG. 3 



